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Abstract 


J  Seam  tracking  is  currently  accomplished  by  special  features  of  the  robot  and  a  priori  knowledge  of  seam 
geometry.  In  this  paper  we  dcmonstratc  Athe  feasibility  of  tracking  a  scam  in  real-time.  A  general-purpose 
scam  tracking  algorithm  is  developed  for  implementation  on  a  robot  with  six  degrccs-of-freedom.  The 
algorithm  is  motivated  by  a  physical  interpretation  of  the  and  matrices,  and  the  assumption  that  3-D 
scam  data  are  available.  In  the  past,  the  matrix  and  inverse  Jacobian  solutions  have  been  used  to 
compute  the  differential  changes  in  the  joint  angles.  By  using  the  inverse  Jacobian,  an  iterative  algorithm  is 
introduced  to  compute  both  large  and  small  changes  in  the  joint  variables.  The  versatile  seam  tracking 
algorithm  can  be  applied  to  a  multitude  of  robotic  seam  tracking  activities  such  as  gluing,  surface  grinding 
and  flame  cutting. 
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1 .  Introduction 

Manufacturing  operations  such  as  robotic  welding,  gluing,  scaling  and  surface  grinding  require  trajectory 
control  of  the  tool  mounted  on  die  end-effector  of  die  robot.  While  the  kinematic  control  algorithm 
developed  in  this  paper  is  applicable  to  a  multitude  of  manufacturing  operations,  robotic  arc  welding 
nomenclature  is  used.  Hie  tool  is  called  the  welding  torch,  and  the  tool  trajectory  is  defined  by  the  weld 
scam.  The  fundamental  problem  is  to  position  a  welding  gun  with  the  proper  translational  and  rotational 
positions  with  respect  to  a  curved  weld  scam  in  three  dimensional  (J-D)  space.  A  seam  in  space  can  be  traced 
by  a  five  dcgrcc-of- freedom  robot.  Since  real-time  scam  tracing  requires  diat  both  the  sensor  and  torch  trace 
the  scam,  a  six  degree-of- freedom  robot  is  required.  Automation  of  the  welding  process  thus  demands  a  robot 
with  six  dcgrccs-of- freedom  and  acceptable  performance  in  terms  of  speed  and  accuracy.  The  control  task 
also  demands  a  real-time  algorithm  to  guide  the  robot  in  a  fixed  geometrical  relationship  to  die  contour. 

Automation  of  the  welding  process  can  be  divided  into  two  distinct  components  : 

•  Seam  data  acquisition  and  interpretation  by  a  sensor  system  ;  and 

•  Guidance- and  control  of  the  robot  to  traverse  the  seam,  while  maintaining  the  proper  orientation 
and  position. 

Since  the  seam  data  constitute  the  3-0  coordinates  of  the  seam,  a  visual  sensory  device  (such  as  a  light  stripe 
imaging  device)  can  be  used  to  obtain  the  scam  data.  Methods  for  obtaining  3-1 )  data  from  2-D  images  have 
been  developed  [Agin  82],  Having  obtained  and  interpreted  the  scam  data,  the  control  system  must  guide  the 
robot  to  traverse  the  seam  and  place  the  requisite  amount  of  weld  material  along  the  path.  The  torch  position 
and  attitude  must  be  controlled  precisely  to  ensure  acceptable  weld  quality. 

Scam  tracking  is  currently  accomplished  by  exploiting  a  special  feature  of  the  robot  or  limiting  the 
application  to  a  particular  type  of  a  scam.  Bollinger  and  Harrison  [Bollinger  71]  describe  the  principles  and 
techniques  of  a  spatial  seam  tracking  system.  In  this  application,  the  scam  is  constrained  to  lie  on  a  cylindrical 
surface.  Tomizuka,  et  al.  [Tomizuka  80]  propose  a  preview  control  strategy  for  two-axis  welding  torch 
positioning  and  velocity  control.  The  scheme  is  only  applicable  for  two-axis  control  and  hence  constrains  the 
seam  to  lie  in  a  plane.  Furthermore,  die  scheme  cannot  be  implemented  on  a  general  purpose  six  dcgrcc-of- 
frccdom  robot. 

One  of  the  first  successful  demonstrations  of  computer  vision  to  arc  welding  is  the  NASA  weld  sAti/e  [Hill 
80].  This  system  has  been  implemented  on  a  special-purpose  robot  and  requires  special  edge  preparation  to 
operate  properly,  'flic  system  is  incapable  of  making  any  determination  regarding  the  joint  fit-up.  The 
principle  of  structured  illumination  has  been  employed  by  Kawasaki  Heavy  Industries  of  Japan  [Masaki  79]  to 
develop  a  visual  seam  tracking  system.  The  approach  used  for  image  analysis  is  training-by-showin g.  A  set  of 


typical  images  is  acquired  in  a  teaching  operation  prior  to  welding  and  stored  in  the  memory  of  the  processor. 
As  real-time  images  arc  acquired,  a  search  is  conducted  (through  the  set  of  trained  images)  until  a  match  is 
found.  During  the  matching  process,  the  positional  displacement  between  the  two  images  is  computed  and 
used  to  correct  the  position  of  the  torch.  The  system  has  been  designed  specifically  for  the  ship  building 
industry  and  hence  operates  only  on  fillet  joints.  The  system  docs  not  utilize  part  fit-up  information  for  scam 
tracking. 

An  example  of  welding-by-teaching  is  the  system  described  by  Masaki,  el  at.  [Masaki  81)  which  has  a  visual 
scam  tracking  capability.  The  robot  is  taught  the  reference  padi  for  the  end-effector  and  the  reference  image 
for  the  image  processor.  In  the  teach  mode,  two  passes  arc  required  for  each  work  piece,  one  for  sensing  and 
one  for  welding.  The  path  for  the  welding  operation  is  generated  from  the  sensing  pass  information. 

Current  robot  welding  systems  arc  thus  suitable  for  large  batches  of  parts  which  are  cut  and  fit  to  tight 
tolerances.  The  robot  must  trace  and  weld  a  scam,  within  acceptable  tolerance  limits,  on  such  closely  fit  parts. 
Another  limiting  factor  for  a  semi-automated  welding  system  is  the  robot  programming  and  set-up  time  in  the 
shop  when  the  part  is  changed.  These  constraints  may  be  eased  through  the  introduction  of  a  CAD/CAM 
data  base  in  which  the  welding  trajectories  and  speed,  weave  pattern,  wire  Iced  rate,  voltage  and  current  are 
stored  for  each  welding  part  and  then  retrieved  as  requited.  Unpredictable  fit-up  and  loose  part  tolerances 
create  the  need  for  a  real-time  guidance  and  control  algorithm. 

The  objective  of  this  paper  is  to  introduce  a  versatile  scam  tracing  algorithm  that  demonstrates  the 
feasibility  of  tracking  a  sCam  in  real-time.  The  general  purpose  seam  tracing  algorithm  can  be 
implcmentablcd  on  any  robot  with  six  dcgrccs-of- freedom.  The  algorithm  is  motivated  by  the  physical 
interpretation  of  die  forward  solution,  or  1'6  matrix  [Paul  81]  and  the  inverse  Jacobian.  To  facilitate 
implementation  of  the  inverse  Jacobian  solutions,  an  iterative  algorithm  is  developed  to  compute  the 
differential  changes  in  the  joint  variables  from  die  dT&  matrix.  To  reduce  significantly  the  on-line 
computational  requirements,  the  concept  of  a  modified  dTfi  matrix  is  also  introduced.  To  evaluate  die 
performance  of  the  scam  tracing  algorithm,  a  functional  simulation  package  (for  the  Cyro1  robot  in  our 
laboratory)  has  been  implemented.  The  outputs  of  die  simulation  are  the  joint  position  and  velocity  set- 
points  for  die  robot  control  system. 

The  paper  is  organized  as  follows.  The  1  i nematics  of  the  Cyro  robot  (including  the  forward  and  reverse 
solutions  ,  and  the  Jacobian  and  inverse  Jacobian)  arc  developed  in  Section  2.  The  foundations  for  the  seam 
tracking  algorithm  arc  laid  in  Section  3.  Focus  is  on  die  specification  of  the  T  matrices  at  the  sample  points 

*Cyro  is  a  trademark  of  the  Advanced  Robotics  Corporation. 
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along  the  scam  and  planning  the  motion  of  the  torch.  To  reduce  the  computational  requirements  of  the 
algorithm  for  real-time  applications,  the  concept  of  the  modified  dT&  matrix  is  introduced  in  Section  4,  and  an 
iterative  algorithm  to  compute  both  large  and  small  changes  in  the  joint  coordinates  is  then  developed.  The 
computational  requirements  are  enumerated  to  indicate  the  potential  for  the  real-time  implementation  of  the 
algorithm.  The  salient  features  of  the  simulator,  which  has  been  implemented  to  evaluate  the  performance  of 
the  scam  tracing  algorithm,  arc  presented  in  Section  5.  Simulation  experiments  for  representative  test  cases 
arc  then  highlighted  in  Section  6.  finally,  in  Section  7.  conclusions  are  drawn  from  the  simulation 
experiments,  and  the  paper  is  summarized. 

2.  Kinematics  of  the  Cyro  Robot 

The  forward  solution  (or  Tfe  matrix)  of  the  robot,  from  the  base  frame  to  the  torch  (or  end-effcctor)  frame,  is 
developed  using  homogeneous  transformations  [Paul  81].  The  homogeneous  transformations,  relating  two 
successive  coordinate  frames,  arc  only  a  function  of  the  six  joint  coordinates.  Thus,  knowledge  of  all  of  the 
joint  coordinates  leads  to  the  transformation  (or  forward  solution)  from  the  base  frame  to  the  torch  frame. 

To  develop  the  homogeneous  transformation  or  A  matrices,  a  coordinate  frame  is  embedded  in  each  of 
six  links  of  the  robot,  using  the  Dcnavit-Hartcubcrg  convention  [Denavit  55 1.  The  coordinate  frames  a*  , 
shown  in  Figure  1.  Joints  1,  2  and  6  are  revolute.  and  joints  3.  4  and  5  are  prismatic.  The  coordinates  of  the 
revolute  joints  arc  0,,  8l  and  and  the  coordinates  of  the  prismatic  joints  arc  xy  z4  and  yy  The  subscripts 
on  lire  coordinates  indicate  the  joint  number;  the  base  is  link  zero.  The  base  coordinate  frame  is  fixed  at  die 
center  of  the  tabic  of  die  robot  and  coincides  with  the  first  coordinate  frame.  When  all  of  the  six  joint 
coordinates  arc  zero,  the  axes  for  joint  1  (table)  and  joint  6  (torch)  arc  parallel  and  the  robot  becomes  singular. 
In  the  algorithm,  the  manipulator  is  assumed  to  be  at  the  zero  position.  Without  loss  of  generality,  the 
constant  offsets  of  die  robot  are  assumed  to  be  zero.  A  counter-clockwise  rotation  of  die  revolute  joints  is 
considered  to  be  positive,  and  translation  of  die  prismatic  joints  along  the  positive  z.-axis  is  considered  to  be 
positive. 

The  link  parameters  of  the  Cyro  robot  arc  listed  in  Table  1,  and  die  forward  solution  is  displayed  in  fable  2. 
Having  obtained  the  forward  solution,  the  values  of  the  joint  coordinates  that  led  to  the  T  matrix  can  be 
computed.  This  reverse  solution  [Paul  81]  is  required  (by  the  simulator)  to  relate  die  'I'  matrix  to  the  present 
values  of  the  joint  coordinates.  The  reverse  solution  is  listed  in  Table  3. 

Hie  differential  changes  in  die  cartesian  coordinates  of  the  torch  arc  related  to  die  differential  changes  in 
the  joint  coordinates  through  the  manipulator  Jacobian  [Whitney  72,  Paul  81].  Kach  column  of  the  Jacobian 
matrix  J  is  a  differential  translation  and  rotation  vector.  The  column  vectors  of 
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arc  listed  in  Table  4. 

In  sea;  'racing,  sensory  data  can  be  utilized  to  determine  the  incremental  change  in  die  position  of  die 
seam  from  differential  changes  in  the  elements  of  die  T  matrix.  The  differential  change  matrix  d'f,  is  thus 
available  to.  plan  die  incremental  motions  of  the  torch.  It  dins  becomes  imperative  to  find  the  inverse 
Jacobian  (or  incremental  changes  in  the  joint  coordinates)  which  produce  the  specified  incremental  change  in 
die  T,  matrix. 

O 

Numerical  inversion  of  the  Jacobian  [Whitney  72)  is  computationally  intensive  and  hence  is  not  suitable  for 
real-time  control  applications.  Incremental  changes  in  the  joint  coordinates  can  be  obtained  from  a  Taylor 
series  expansion  of  the  reverse  solution.  Such  an  approach  leads  to  analytical  formulae  for  the  differential 
joint  coordinates  which  arc  functions  of  the  elements  of  the  lb  and  d  I  f)  matrices  [Paul  8 1 1.  Analytical 
formulae  for  the  differential  joint  coordinates,  which  are  obtained  bv  differentiating  the  reverse  solution  (in 
fable  3).  arc  listed  in  fable  5. 

3.  Kinematic  Seam  Tracking  Control 

The  control  task  is  to  fill  a  volume  with  weld  material  while  maintaining  the  piopcr  position  and  orientation 
of  the  torch  with  respect  to  the  seam.  While  travel  sing  the  seam,  the  tip  ol  die  torch  traces  a  curve  in  3-1) 
space.  If  the  discrete  points  on  the  curve  to  be  traced  and  the  surface  containing  the  curve  are  identified,  the 
1 6  matrices  can  be  generated  for  each  point  on  the  discretized  curve. 

Specification  of  the  T&  matrices  at  the  sample  points  of  die  discretized  curve  accomplishes  die  seam  tracing 

task,  flic  T,  matrix  is 
0 
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and  represents  the  position  and  orientation  of  the  torch  shown  in  Figure  2.  'flic  origin  of  the  describing 
coordinate  frame  is  located  at  the  tip  of  the  torch  and  is  described  by  the  vector  p  with  respect  to  the  base 
frame.  The  three  unit  vectors  n,  o  and  a,  which  describe  die  orientation  relative  to  the  base  frame,  arc 
directed  as  follows  [Paul  81].  flic  7-axis  of  the  describing  frame  lies  along  the  direction  that  die  torch 
approaches  the  surface  (containing  the  curve  to  be  traced)  and  is  called  die  approach  vector  a.  The  y-axis  of 
the  describing  frame  lies  along  the  direction  of  the  boom  bolding  die  camera  and  is  called  the  orientation 
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vector  o.  The  normal  vector  n  is  then  chosen  to  form  a  right-handed  set  of  vectors  and  is  computed  as 

n  =3  x  it 

The  vectors  n,  o  and  a  describing  the  orientation  of  the  torch  and  the  vector  p  describing  the  position  can  be 
specified  independently.  The  control  task  can  thus  b'c  split  into  two  independent  components  : 

•  Tracing  a  curve  in  3-D  space;  and 

•  Maintaining  proper  orientation  of  the  torch  with  respect  to  the  surface  which  contains  the  curve  to 
be  traced. 

The  volume  to  be  filled  with  the  weld  material  is  contained  within  two  surfaces  (of  metal)  which  are  to  be 
joined  together.  The  surfaces  may  be  non-overlapping,  as  in  the  ease  of  a  butt  joint  (in  Figure  3).  or 
overlapping  as  in  the  case  of  a  lap  joint  or  a  fillet  joint. 

Let  m  be  a  curve  (in  3-D  space)  which  lies  on  the  surface  S  and  is  to  be  tiaccd  by  the  tip  of  the  torch.  The 
surface  S  may  have  a  varying  slope.  Henceforth,  die  curve  m  will  be  termed  the  mid-seam.  The  mid-scam  is 
discretized  length-wise.  Let  m.  be  the  vector  (with  respect  to  the  base  frame)  pointing  to  the  i-lh  sample  point 
nr  on  the  mid-scant.  The  discretization  is  specified  to  allow  a  piecewise  linear  approximation  of  the  curse  m 
between  two  adjacent  sample  points.  If  die  surface  (in  the  vicinity  of  the  two  sample  points  uv  and  m.  H  ()  is 
also  discretized,  dicn  a  piecewise  planar  approximation  of  .V  is  obtained.  Let  />.  denote  the  plane  (containing 
the  points  nv  and  m.  ,).  The  direction  cosines  of  the  plane  specify  the  orientation  of  the  torch  which  is  held 
constant  for  the  duration  of  travel  from  nr  to  m|  +  j. 

The  position  of  the  torch  is  specified  by  the  coordinates  of  the  sample  points.  The  foregoing  description  of 
the  position  and  the  orientation  of  die  torch  completes  the  formulation  of  die  Tfc  matrix  at  die  sample  points. 
The  ensuing  section  specifics  the  Tft  matrix  for  butt,  lap  and  fillet  joints. 

3.1 .  Specification  of  the  Matrix 

Having  interpreted  physically  the  elements  of  the  Tft  matrix,  die  next  step  is  u>  generate  numerical  values  of 
the  elements  of  the  T&  matrix  in  terms  of  the  coordinates  of  the  sample  points  obtained  from  the  sensor 
system.  Since  a  light  stripe  projector  and  a  solid  state  camera  arc  assumed  to  be  used  as  the  sensory  device, 
the  3-D  coordinates  of  the  points  on  the  surfaces  to  be  joined  arc  mapped  into  pixels  in  the  camera  image. 
Figure  4  shows  a  typical  camera  image  (at  the  i-th  sampling  instant)  obtained  from  a  butt  joint.  The  break 
points  in  the  camera  images  of  the  surface  indicate  the  discontinuity  in  the  actual  surfaces  to  be  welded.  To 
specify  the  curve  to  be  traced,  it  is  essential  to  extract  3-D  coordinates  of  die  break  points  in  die  images.  The 


information  regarding  the  orientation  of  die  surfaces,  in  die  vicinity  of  die  break  points,  can  be  obtained  by 
extracting  the  coordinates  of  one  additional  point  on  each  surface.  The  break  points  arc  called  ir  and  v.  for 
die  butt  joint  shown  in  Figure  3.  The  additional  points  on  each  of  die  two  surfaces  are  called  pi  and 
respectively.  The  subscript  i  denotes  the  sampling  instant.  I  hc  coordinates  of  the  sample  points  are  specified 
with  respect  to  the  base  frame  of  die  robot,  and  p..  a.  v.  and  q.  a  the  vectors  from  the  origin  of  the  base 
frame  to  the  points  p;.  rr,  v.  and  q(  respectively.  The  edges  formed  by  die  sample  points  {  p|  },  {  q(  },  {  u  } 
and  {  v(  }  arc  denoted  by  p.  q.  u.  and  »>.  respectively. 

To  specify  the  p  vector  of  the  Tb  matrix  requires  knowledge  of  the  sample  points  along  die  mid-seam,  For  a 
butt  joint,  the  requirement  dial  the  torch  be  placed  exactly  in  the  middle  across  die  u  and  v  edges  forces  the  x. 
y  and  i.  coordinates  of  the  mid-scam  to  be  computed  as: 


m„  = 


m„  = 


+  v»i 
2 

»yi  +  Vyi 
2 

“a  +  V,,j 

2 


0) 


For  both  lap  and  fillet  joints,  torch  stand-off  is  an  important  consideration  for  obtaining  a  quality  weld.  I  ct 
die  desired  torch  stand-off  be  characterized  by  the  parameter  s.  where  s  ranges  from  0  to  1.  The  coordinates 
of  the  mid-seam  arc  dien  computed  as 


m,j  =u„  +  s(  vxi— uxl) 

myj  =Uyi  +  s(  Vyj  — Uyi) 

mz;  =  Uji  +  s(  v7j  — ■ uzj) 


(2) 

px,  Py  and  pz  components  of  the  T&  matrix  arc 

Px  =  mxi 

(3) 

Py  =  "Vi 

(4) 

Pz  *  "Vi 

(5) 

and  specify  completely  the  last  column  of  the  T&  matrix. 


Practical  scams  have  edges  with  slowly-varying  slopes.  Since  die  sample  points  arc  assumed  to  lie  close  to 
each  other  (typically  separated  by  1  mm),  die  edges  between  two  sample  points  can  be  approximated  by  a 


straight  line.  This  approximation  leads  to  a  plane  which  passes  through  at  least  three  of  the  four  sample 
points  (p.,  p.  y  q.,  q.  + 1).  The  direction  cosines  of  die  plane  arc  also  the  direction  cosines  of  a  vector  normal 
to  die  plane.  Since  die  torch  is  required  to  be  perpendicular  to  the  fictitious  scam  surface,  the  direction 
cosines  of  die  approach  vector  a  arc  specified  as  the  negative  of  the  direction  cosines  of  the  normal  to  the 
plane. 

The  values  of  the  components  of  the  orientation  vector  o  arc  computed  under  die  following  constraint. 
When  the  torch  and  the  camera  are  on  the  seam,  both  should  track  the  scam.  This  condition  guarantees  dial 
sample  points  will  not  be  lost  if  the  slope  of  die  mid-edge  (at  the  point  of  the  torch)  differs  from  the  slope  at 
ihc  point-of-view  of  the  camera.  I.et  VI  be  a  constant  shift  in  the  number  of  sample  points  between  the  torch 
and  the  camera,  l-igure  2  shows  that  the  o  vector  is  perpendicular  to  die  a  vector  and  points  along  the 
direction  of  the  arm  holding  the  camera.  If  the  camera  is  traveling  in  the  direction  of  the  line  joining  im  f  v, 
and  mi+N,  then  die  robot  system  will  never  lose  track  of  the  seam,  unless  the  slope  experiences  large  changes 
or  discontinuities  along  the  scam. 

The  equation  of  a  plane  passing  through  three  of  die  four  points  (pj+  v  Pj  +  vr  qj  +  v  qj+  v()  can  now  be 
specified,  and  die  angle  between  die  planes  at  die  camera  and  the  torch  points  can  be  determined.  If  (X(. 
i>{)  and  (\2,  pr  I'd  arc  the  direction  cosines  of  the  two  planes,  then  the  cosine  of  angle  6  between  the  planes 
is 

cos(0)  =^1X2  +Pl)*2  +<'t*'2 

(6) 

'Hie  vector  a  joining  the  points  mj+  and  mj  +  N  along  the  mid-edge  is  computed  as 
3  =  hV+N  ~  thi+N-i 

(7) 

The  projection  of  the  vector  a  onto  the  torch  plane  is  chosen  to  be  the  0  vector  and  is  normalized  to  be  of  unit 
length.  Having  obtained  the  normalized  o  and  a  vectors,  die  11  vector  is  computed  as 

«  =  <J  x  1 

(8) 

to  specify  completely  die  T&  matrix  at  die  sample  points. 

While  traversing  from  die  i-th  to  die  (i  +  l)-lh  point,  die  orientation  of  the  torch  and  consequently  die  n,  0 
and  a  vectors  remain  constant.  The  p  vector  in  die  Tft  matrix  changes  linearly  because  of  die  straight  line 
approximation  between  the  two  points.  To  maintain  a  continuous  speed  and  acceleration  at  die  end  points  of 
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the  segment,  the  motion  of  die  torch  is  planned. 

3.2.  Planning  the  Motion  of  the  Torch 

The  motion  of  the  tip  of  the  torch,  in  traversing  a  segment,  is  composed  of  two  parts: 

•  Motion  along  the  segment,  and 

•  Transition  between  segments. 

To  make  a  smooth  transition  between  segments,  it  is  desirable  to  maintain  a  continuous  velocity  and 
acceleration  at  the  transition  points.  To  specify  the  transition  equations,  a  fourth-order  curve  is  fit  between 
the  point  where  a  transition  starts  and  die  point  indicating  the  end  of  the  transition  [Paul  81],  The  equations 
for  the  transition  trajectories  and  velocities  arc  outlined  in  Section  3.3. 

Let  M  be  the  total  number  of  transition  steps  in  which  the  desired  change  in  Tfi  is  to  occur.  The  differential 
changes  in  the  n,  o  and  a  vectors  at  each  transition  point  arc 


Art  = 


M 


(9) 


Alt  = 


3<i  hi)  ~3j 
M 


(10) 


Ad  = 


0(1+1)  ~fij 
M 


(11) 

where  die  subscripts  i  and  (i  +  1)  denote  the  i-th  and  (i  +  l)-di  segments,  respectively.  Hie  An,  Ao  and  Aa 

vectors  arc  then  added  to  the  current  n,  o  and  a  vectors,  respectively,  and  normalized  to  unit  length,  to 

produce  the  n.  o  and  a  vectors  at  the  next  segment.  Let  n  .  o a„  and  n  ,  o  ,  a  be  the  vectors  of  the  T.  matrix 

pp  pnnn  (> 

at  die  present  and  next  segments,  respectively;  and  let  the  subscript  N  indicate  that  dicsc  vectors  have  been 
normalized  to  unit  length.  The  nn,  on  and  an  vectors  arc  dius  computed  as  follows  : 


0n=(0p+An)N 

(12) 

On  =(0p  +Ao)n 

(1-1) 
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3n  =(ifp  +/T;i)n 


Having  computed  the  three  component  vectors  (n,  o  and  a)  of  T  at  the  next  segment,  the  first  three 
columns  of  the  differential  change  matrix  dTb  arc  determined,  and  the  fourth  column  (or  dp  vector)  can  be 
computed  from  the  transition  trajectory  to  specify  the  differential  translation.  The  differential  change  matrix 
d T,  is  then 

O 


dn,  do,  da,  dp, 
dny  doy  day  dpy 
d'f,-dn,  do,  da,  dp, 
0  0  0  0 


where  the  differential  vector  components  (dn.  do,  da  and  dp)  of  the  d' T  matrix  represent  the  corresponding 
change  in  the  vector  components  (n.  o,  a  and  p)  of  the  l  &  matrix. 

Having  generated  the  present  T  matrix  and  d’l(  matrix  to  reach  the  next  point,  die  inverse  Jacobian  (in 
Table  5)  is  used  to  compute  iteratively  the  differential  changes  in  the  joint  coordinates.  The  inveisc  Jacobian 
solutions  arc  derived  under  die  assumption  that  the  changes  in  the  joint  variables  leading  to  dte  specified  d'l6 
matrix  are  small.  1  o  overcome  the  practical  fact  that  this  assumption  is  not  always  satisfied  in  seam  tracing 
applications,  an  iterative  technique  is  developed  to  compute  the  changes  in  the  joint  variables.  The  velocity 
set-points  during  the  transition  are  obtained  by  dividing  the  incremental  values  of  the  joint  variables  by  the 
time  required  to  make  the  incremental  change.  The  transition  ends  when  die  torch  reaches  die  point  I)  on  the 
segment  B-C  in  Figure  5.  At  this  point,  the  torch  has  the  required  orientation  and  velocity  to  track  the 
(i  +  1  )-th  segment  D-C  without  error.  This  motion  is  called  motion-along- the- segment. 


During  die  motion  of  the  torch,  along  the  segment,  the  n,  o  and  u  vectors  of  die  robot  remain  constant.  The 
updated  dl  6  matrix  is  specified  as: 


0  0  0  dp, 
0  0  0  dpy 
dTfi  =  0  0  0  dp, 
0  0  0  0 


where  dp  ,  dp  and  dp  arc  the  differential  changes  in  the  x,  y  and  /.  coordinates  of  die  (i  +  l)-th  transition 
x  y  i 


point.  When  the  torch  reaches  the  next  transition  point,  the  process  of  planning  the  motion  of  the  torch, 
along  the  segment  and  during  die  transition,  is  repeated  to  plan  the  motion  for  the  next  segment. 


3.3.  The  Transition  Curves 

A  transition  segment  is  illustrated  in  figure  5.  The  transition  starts  at  point  A  in  the  i-th  segment  and  ends 
at  point  D  in  die  (i  +  l)-th  segment.  Maintaining  a  continuous  velocity  and  acceleration  at  die  points  A  and  D 
appears  to  require  that  six  boundary  conditions  be  satisfied.  A  lifih-order  polynomial  (with  six  para  meld's) 
would  dicn  be  needed  to  approximate  the  cartesian  transition  curve.  Symmetry  of  die  transition  guarantees 
dial  a  quart ic  polynomial  can  approximate  the  cartesian  transition  curve  (Paul  81p.  To  facilitate  the 
development,  let  r  be  the  transition  time  and  T  be  die  time  required  to  traverse  the  segment  l)-C.  The  time  of 
travel  (  T  )  across  a  segment  is  computed  by  dividing  die  volume  of  the  weld  material  (to  be  deposited  along 
the  segment)  by  the  weld-wire  volumetric  feed-rate,  which  is  assumed  to  be  constant.  The  ratio  (t/T)  is 
specified  by  die  engineer  (in  Section  6).  I  et  die  normalized  time-step  parameter  li  be  defined  according  to 


(17) 

where  t  denotes  the  running  time  variable  (-r  <  t  <  r). 

I  et  the  fourth-order  polynomial  approximating  the  cartesian  transition  segment  be 
X(li)  =/?., h'  +/?, h5  t-frh2  +/?|h  +f}0 

where  the  five  parameters  (/T  for  i  =  0  to  4)  must  be  selected  for  X(h)  to  satisfy  die  boundary  conditions 
(Paul  81| : 

X(0)  =  A  ;  X(  1)  =(C-B)y  +  B 

T  (18) 
X(0)  =  2( li-A)  ;  X(l)  =2(C-B>y 

(19) 

X(0)  =0  ;  X(l)  =0 

(20) 

where  the  Jot  denotes  differentiation  with  respect  to  h.  (The  initial  acceleration  condition  X(0)  =  0  leads  to 
02  =  0.) 

The  cartesian  position,  velocity  and  acceleration  of  the  torch  on  the  transition  curve  (as  functions  of  the 
normalized  time-step  parameter  li)  arc 

Z\>\c  transition  equations  arc  reproduced  here  because  of  the  typographical  errors  in  the  ctlcd  reference. 
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X(h)  =  -(ACy  -AB)h4  +  2( AC y  -  All)h3  +  2(AR)h  +A 
X(h)  =  -4(ACy  -AB)hJ  +  6(ACy  -  AIRh2  +2(AB) 


and 


(21) 

(22) 


X(h)  =  — 12(ACy  —  AB)h2  4-  12(ACy  -AB)h 


where  A B  =  (B  -  A)  and  AC  =  (C  -  11). 


(23) 


Hquation  (21)  defines  the  cartesian  position  of  the  torch  (in  terms  of  the  normalized  time-step  parameter  h) 
and  is  used  to  evaluate  the  coordinates  of  the  transition  point.  The  welding  torch  transits  from  the  present 
segment  to  the  next  and  maintains  a  continuous  velocity  and  acceleration  at  the  end  points  (A  and  I)  in  [figure 
5)  of  the  transition  segments.  Hquation  (21)  is  used  to  compute  the  position  of  the  torch  during  the  transition. 
In  the  next  section,  the  n,  o  and  a  vectors  for  the  transition  arc  formulated. 


4.  The  Modified  dT,  Matrix 

The  dTft  matrix  specifics  an  incremental  change  in  the  orientation  and  position  of  the  torch  induced  hy 
incremental  changes  in  the  joint  coordinates.  Seam  tracing  requires  incremental  changes  (in  the  base 
coordinates)  in  both  the  position  and  orientation  of  die  torch.  Since  die  changes  in  the  base  and  the  joint 
coordinates  arc  related  through  the  nonlinear  inverse  Jacobian  coordinate  transformation,  a  small  change  in 
the  position  and  orientation  of  die  torch  in  the  base  coordinates  may  require  a  large  change  in  die  joint 
variables.  This  realization  hampers  application  of  die  inverse  Jacobian  to  compute  the  differential  changes  in 
the  joint  coordinates  from  die  dTft  matrix. 

‘Hie  goal  of  this  section  is  to  introduce  the  concept  of  a  modified  dTfi  matrix  and  an  iterative  algorithm 
which  docs  not  restrict  the  nature  of  changes  in  the  joint  variables  that  led  to  the  specified  d!'b  matrix  [Khosla 
83].  If  the  changes  arc  incremental  (as  assumed  for  the  derivation  of  the  inverse  Jacobian),  then  the  algorithm 
converges  in  the  first  iteration.  In  die  case  of  large  changes,  die  algorithm  converges  rapidly  (in  typically  2-3 
iterations  for  the  examples  highlighted  in  Section  6)  to  the  appropriate  differential  changes  in  the  joint 
coordinates,  'flic  Tfc  matrix  at  the  next  point  is  computed  by  adding  the  present  T&  matrix  to  die  modified 
dTft  matrix.  This  approach  reduces  computation  time  because  computing  the  next  T  matrix  docs  not  require 
the  forward  solution. 


Let  R  and  S  be  two  points  on  the  mid-scam  transition  segment  bci-vcen  the  points  A  and  D  (in  Figure  6). 
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Let  the  position  and  the  orientation  of  the  torch  at  points  R  and  S  be  specified  by  TfiR  and  T()S.  respectively, 
l.et'l'^  be  such  that  the  change  dTfc  in  TftR  leads  to  T6S.  Thus, 


T~ts  =  Ar  +  dTb 


(24) 

It  is  also  possible  to  reach  T&s  from  l'6|<  through  a  transformation  C  (in  the  base  coordinates)  which  consists 
of  a  translation  along  the  x,  y  and  /.  axes  followed  by  a  rotation  0  along  an  axis  k.  Thus. 


r6S  =ct, 


6  K 


where 


(25) 


C  =  Trans  (x.y.z)llot(k.O) 


(26) 


Let  nR,  o..  and  aR  be  the  component  vectors  of  the  TfeR  matrix  specifying  the  orientation  of  the  torch  at  the 
point  R.  and  n^,  (>s  and  a^  lie  the  corresponding  vectors  of  the  TftS  matrix.  From  (24).  the  cot  responding 
differential  vectors  dn,  do  and  (la  arc 

till  -  "s  ~ 

(27) 

do  =  «v  -  Or 

(28) 

da  —  (i,v  ~  aR 

(29) 

While  traveling  from  point  A  to  point  D  (in  Figure  5).  die  d  l'6  matrices  should  be  computed  to  preserve  the 
physical  significance  of  the  T  matrices  at  the  transition  points.  Thus.  should  be  computed  from  dTfi 
according  to  (24).  Geometrically,  the  loci  of  the  n.  o  and  a  vectors  of  a  T&  matrix  should  be  a  sphere  of  unit 
radius. 


Figure  6  depicts  the  total  desired  change  in  each  of  the  n,  o  and  a  vectors,  while  traversing  from  point  A  to 
point  D  (in  Figure  5)  in  M  steps.  The  components  An,  Ao  and  Aa,  computed  from  (30)-(32),  arc  shown  in 
Figure  6.  The  arc  of  the  unit  circle  represents  the  loci  of  the  n,  o  and  a  vectors  during  ihc  transition.  Let 
(nK)u,  (oR)u  and  (aR)u  be  the  unnormalized  vectors  whose  tips  lie  on  the  point  «/  on  the  straight  line  joining 
points  A  and  D.  The  subscript  u  indicates  that  the  vectors  arc  unnormalized.  The  vectors  nR,  oR  and  aR  arc 
obtained  by  normalizing  the  magnitude  of  the  corresponding  vectors  to  unit  length. 
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Hie  unnormalized  vectors  of  the  I'6S  matrix  arc  computed  as 

( >ls)u  =(>l,)u  +£" 

(30) 

(os)u  =ior)u  +So 

(3D 

(dj)u  =4,(lr)u  +Sa 

(32) 

and  then  normalized  to  obtain  the  ns,  os  and  as  vectors.  The  riglu-hand  sides  of  (27)-(29)  arc  thereby 
specified  completely,  and  the  differential  vectors  of  the  dTfe  matrix  can  be  computed  to  preserve  the  physical 
significance  of  die  T  matrix. 

Having  obtained  the  dn,  do  and  da  vectors  of  die  d  l'6  matrix  in  (15),  it  remains  to  compute  the  dp  vector  to 
specify  completely  the  matrix.  The  vector  dp  is  computed  as 

‘Ip  =Ps  ~Vr 

where  the  vectors  pR  and  ps  are  obtained  from  (21). 

Hy  construction,  the  d  l  6  matrix  satisfies  (26).  Since  the  magnitudes  of  the  changes  in  the  joint  variables  arc 
not  constrained  in  the  derivation  of  the  dTf>  matrix,  the  computed  dTft  matrix  satisfies  (27).  Thus,  the  Tf) 
matrix  at  the  next  point  S  can  be  obtained  by  adding  the  Tfc  matrix  at  the  present  point  R  to  the  computed 
dTh  matrix  (and  consequently  there  is  no  need  to  compute  the  l'b  matrix  at  die  point  S  from  the  updated 
values  of  the  joint  variables  when  the  torch  reaches  the  point  S).  The  real-time  computational  requirements 
of  this  construction  arc  detailed  in  Section  5. 


4.1 .  An  Iterative  Algorithm  to  Compute  the  Differential  Changes 

In  applications,  such  as  scam  tracing  (in  which  the  sample  points  lie  at  incremental  distances  along  the 
scam),  die  required  changes  in  the  joint  variables  may  not  be  incremental.  A  practical  example  involves 
tracing  a  scam  which  has  large  slope  variations.  The  dT&  matrix  is  related  to  the  changes  in  the  joint  variables 
through  die  inverse  Jacobian  which,  in  turn,  is  derived  under  the  assumption  of  small  changes  in  die  joint 
variables.  Many  of  the  scams  occurring  in  practice  have  slowly  varying  slopes  and  application  of  die  inverse 
Jacobian  to  make  the  incremental  motions  is  computationally  advantageous.  In  practice,  die  scam  may 
exhibit  large  slope  changes  at  a  few  points,  and  the  solution  obtained  (for  die  differential  changes  in  die  joint 
coordinates  to  reach  the  next  point)  from  the  inverse  Jacobian  may  exhibit  significant  errors.  The  torch  is 
thus  placed  at  the  incorrect  point  on  the  seam,  and  a  large  error  (in  the  position  and  orientation  of  the  torch) 
is  introduced.  To  overcome  this  problem,  an  iterative  algorithm  is  introduced.  A  block-diagram  of  the 
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iterative  algorithm  is  shown  in  Figure  7. 

The  algorithm  begins  at  i  =  0  with  the  initialization  of  the  following  variables:  I'6*  (T  matrix  of  the  next 
point),  Tbi  (current  Tb  matrix),  and  qj  +  j  (current  values  of  the  joint  variables). 

The  algorithm  implemented  at  the  i-th  iteration  is  : 
dT6  =  T6*  -  T6i 

(33) 

dq(  fl  =J-1[dT6i.qi  +  1J 

(34) 

Qi  4-1  =Qi  Klqj+i 

(35) 

T6i=FIqi+tJ 

(36) 

di  =l3(qi+i] 

(37) 

where  J'1  is  the  inverse  Jacobian  (in  Table  5)  for  the  computation  of  the  differential  changes  in  the  joint 
variables  from  d  l'  and  qj+l  (in  contrast  to  the  symbolic  or  numerical  inversion  of  the  Jacobian  matrix);  F 
denotes  the  operation  of  computing  the  T  matrix  (in  Table  2);  and  H  signifies  the  computation  (delay)  time 
for  the  forward  solution. 

Upon  substituting  (34)  into<35), 

Qi  + 1  =  Qi  +J"‘[clT6i,qi  +  ,J 

(38) 

and  hence, 

d<li  n  =(qi+i  -Qi)  =J"‘ldT6i.qi  +1J 

(39) 

Hquation  (39),  and  consequently  the  algorithm  depicted  in  Figure  7,  is  the  Newion-Raphson  method 
[Atkinson  78]  for  solving  the  inverse  Jacobian  system  of  nonlinear  equations  (in  Table  5). 

The  algorithm  converges  (in  theory)  when  oil  of  the  components  of  the  d T  matrix  in  the  block-diagram  (in 
Figure  7)  arc  zero.  In  practice,  the  algorithm  is  assumed  to  converge  when  each  of  die  elements  ofd  Tbj  is  less 
than  a  pre-set  tolerance.  ITic  computed  vector  q.  contains  the  desired  set-points  (in  die  joint  variables)  to 
reach  the  next  position.  When  the  desired  changes  in  the  joint  variables  arc  small,  the  algorithm  converges  in 
one  iteration  and  reduces  to  obtaining  the  inverse  differential  solutions  from  the  inverse  Jacobian  (in  Table  5). 
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For  the  scams  tested  with  the  simulator,  the  algorithm  always  converged  in  a  maximum  of  three  iterations 
(when  the  preset  tolerance  was  set  equal  to  zero).  The  computational  requirements  of  the  scam  tracing 
algorithm  arc  outlined  in  the  next  section. 

5.  Computational  Requirements 

The  computations  required  to  follow  the  scam  from  die  present  sample  point  to  the  next  are  outlined  in 
Table  6.  The  number  of  iterations  required  for  the  transition  point  computation  and  iterative  algorithm 
(33)-(37)  arc  denoted  by  N  L  and  N,,  respectively.  (For  the  scams  traced  by  the  simulator,  typical  values  are 
found  to  be  Nj  =  2  and  N2  =  1.)  Kxccution  times  of  the  8087  hardware  instructions  [Intel  83]  arc  listed  in 
Table  7.  These  floating  point  operation  times  (including  the  times  required  to  load  and  store  the  operand)  arc 
used  u>  estimate  die  time  required  to  move  die  torch  from  one  sample  point  to  die  next.  Typical  times  (shown 
in  Table  6)  range  from  24  to  29  milliseconds,  which  correspond  to  sampling  rates  of  35-40  Hz.  For  most 
welding  applications,  a  sampling  frequency  of  10  Hz  appears  to  be  adequate. 

These  computational  estimates  arc  based  upon  the  matrix  kinematic  modeling  of  manipulators  used 
throughout  this  paper.  Matrix  representations  of  rotations  arc  highly  redundant.  Quaternions  [Beeler 
72.  Hamilton  69]  offer  a  convenient  representation  for  rotations  and  can  reduce  both  the  storage  requirements 
and  computational  load  ['Taylor  79|.  The  authors  estimate  dial  the  quaternion  implementation  of  the  scam 
tracking  algorithm  would  increase  die  achievable  sampling  rate  to  60  Hz.. 

6.  Simulation 

To  evaluate  the  algorithm,  a  software  simulator  has  been  developed  (in  the  C  programming  language  on  a 
VAX  11/780)  for  the  six  dcgrcc-of- freedom  Cyro  robot  in  our  laboratory.  The  simulation  is  initialized  by 
retrieving  scam  data  (as  coordinates  of  sample  points)  from  a  data  file.  The  first  two  sampled  cross-sections  of 
the  scam  arc  used  to  compute  the  desired  Tfi  matrix  of  the  robot  at  the  first  point  on  the  mid-seam  and  to 
compute  the  joint  position  and  velocity  set-points  to  reach  the  desired  destination.  Upon  reaching  the  first 
point  on  the  mid-seam,  the  algorithm  computes  the  coordinates  of  the  transition  point  oil  this  segment  (for 
the  ratio  -r/T  which  is  entered  by  the  engineer  at  the  start  of  the  simulation)  and  the  total  time  T  required  to 
traverse  the  next  segment.  'The  T&  matrices  at  the  present  and  next  sample  points  arc  used  to  generate  the 
joint  position  and  velocity  set  points  by  the  algorithm  in  (33)-(37).  The  trajectory  from  die  beginning  to  end 
of  die  transition  is  computed  from  (21),  and  the  joint  position  and  velocity  set-points  arc  computed  to  follow 
the  interpolated  curve.  Upon  reaching  die  end  of  the  transition,  the  process  is  repeated  (for  each  transition 
point),  until  the  last  sample  point  is  reached.  The  simulation  is  dicn  terminated  and  the  specified  curve  is 
traced. 
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To  achieve  a  quality  weld,  the  lag  or  lead  angle  of  tile  torch  must  be  controlled  adaptively.  In  the  case  of 
fillet  and  lap  joints,  the  torch  stand-off  must  also  be  controlled.  Since  an  adaptive  controller  for  these 
parameters  remains  to  be  developed,  we  have  included  (in  our  simulator)  the  facility  to  specify  these  control 
parameters  at  the  beginning  of  the  simulation. 

In  the  software  simulator,  the  torch  can  be  rotated  about  nm  axes.  The  first  is  about  an  axis  parallel  to  the 
direction  of  travel  and  the  second  is  about  an  axis  perpendicular  to  the  direction  of  travel  (in  the  plane  of  the 
first  axis).  This  capability  allows  control  over  die  lead  or  lag  angle  of  the  torch,  f  acility  to  specify  the 
stand-olT  for  lap  and  fillet  joints  has  also  been  incorporated.  The  simulator  has  tracked  butt,  lap  and  fillet 
joints  and  die  experimental  results  are  highlighted  in  the  next  section. 


7.  Experimental  Results 

The  seam  tracking  algorithm  approximates  the  curve  between  sample  points  by  a  straight-line.  To 
emphasize  the  effect  of  linear  interpolation  and  the  choice  of  sampling  distance  on  the  tracking  accuracy,  the 
simulator  tracked  a  sinusoidal  curve  (with  uniform  spucings  of  30  and  10  degrees).  The  simulation  results  arc 
depicted  in  Figures  8  and  9,  respectively.  As  the  sampling  distance  is  decreased,  die  tracked  curve  approaches 
the  actual  curve.  The  maximum  tracking  error  (  which  occurs  for  h  =  0.5)  is 


• =  i?ACT -tV48 


and  depends  upon  AH,  AC  and  the  ratio  r/T.  For  a  particular  scam  and  sample  points.  AH  and  AC  are 
constant  and  the  tracking  error  (with  respect  to  die  interpolated  curve)  is  a  linear  function  of  die  ratio  t/T. 
The  simulation  experiments  illustrate  that  accurate  tracking  can  be  achieved  by  judiciously  selecting  the 
sample  points  and  maintaining  the  ratio  (r/T)  of  transition  time  to  segment  time  as  small  as  possible. 


8.  Conclusions 

A  general-purpose  real-time  scam  tracing  algorithm,  for  implementation  on  any  six  degrce-of- freedom 
robot,  is  proposed.  The  algorithm  (which  requires  knowledge  of  only  onc-poini-ahcad  to  track  a  seam)  can  be 
applied  to  a  multitude  of  robotic  scam  tracking  activities  such  as  gluing,  surface  grinding  and  flame  cutting. 
'Hie  algorithm  incorporates  die  physical  interpretation  of  the  T&  and  dT  matrices  to  realize  seam  tracking.  To 
reduce  the  computational  requirements,  die  paper  introduces  the  concept  of  a  modified  dT  matrix.  The 
inverse  Jacobian  solution  is  generalized  (according  to  Newton’s  rnediod)  to  compute  both  large  and  small 
changes  in  the  joint  coordinates. 

To  test  the  efficacy  of  die  proposed  scam  tracing  algorithm,  a  simulator  has  been  written  and  tested  on  a 
VAX  11/780.  The  simulation  results  arc  highlighted  in  Section  7  of[Khosla  83).  The  tracking  accuracy  is  a 
function  of  the  sampling  distance  because  of  die  straight-line  approximation  between  two  successive  sample 
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points,  and  the  tracking  error  increases  with  the  increase  in  ratio  of  the  transition  time  to  the  segment  travel 
time. 

Future  activity  will  Focus  on  the  adaptive  control  of  the  weld  parameters  and  dynamic  robot  control. 
Successful  practical  implementation  will  depend  upon  the  availability  of  faster  processors  and  the 
experimental  performance  evaluation  of  the  algorithm. 
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Figure  3:  Butt  Joint 


Figure  4:  Camera  Image  of  a  Butt  Joint 


4 
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FigureS:  A  Transition  Segment 


Note-  The  generic  vector  g  symbolizes  the 

normal  (n),  orientation  (o)  and  approach 
(a)  vectors. 


Figure  6:  Locii  of  a,  o  and  a  Vectors 
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Figure  7:  Block  Diagram  of  the  Iterative  Algorithm 
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Definition  of  the  Parameters 
6  is  the  angle  of  rotation  about  the  e-axis 
a  is  the  angle  of  rotation  about  the  x-axis 
a  is  the  length  of  translation  along  the  x-axis 

d  is  the  length  of  translation  along  the  e-axis 
Table  1:  Link  Parameters  of  the  CYRO  Robot 


QCjQ  +  SjSj 
SiQC*  -QS* 

-sa 


0 


-CAS*  +sa 

~  SiCjS*  —  CjC* 
SjS, 

0 


”  CtSj  Cj(  Z4S2  +XjCj  —  HSj)  —  Sj(  —  yj  +L) 
“SjSj  S^Sj  +XjCj  —  HSj)  +  Cj(  —  yj  +L) 
-C2  (  X4C2  -xjSj  -HCj)  -R 

0  1 


Table  2:  Forward  Solution  of  the  CYRO  Robot 


Joint  coordinate 

Analytical  Expression 

Conditions 

ft 

a  tan! 

a x 

r6(2,3)>  0 

ft 

r6(2.3)<  0 

ft 

aM„2  t?'V] 

xj 

C\C]px  +S\CjPy  —  S^pt  —  SiR 

24 

C\SlPx  +  S\SlPy  +C2P1  +C2R  +  H 

ys 

S\ px  —  C\Py  +  L 

*6 

atanl 

ft>  0 

ft 

atanl  —  +180® 

~*i 

ft<  0 

NOMENCLATURE 
Ct  is  the  Cosine  of  the  i-lh  joint  angle 
Si  is  the  Sine  of  the  i-th  joint  angje 
atan2  is  the  double  argument  arc  tangent  function 


Table  3:  Reverse  Kinematic  Solution  of  the  CYRO  Robot 


3T * 
301 


-(CjCjC*  +SiS*)(v*rl)  +(S;C2C*  -CiS*)(var2) 

-<CiCiS*  +SA)(varl)  +( ”  S,C2S*  -cic*Hy$tV 
CjS?(varl)  -SjSj(var2) 

-SjC* 

SjS* 

-C, 


3T> 

dOl 


-C jQ(var3)  +SiCi(var4) 
CjS*(var3)  -SjQ(var4) 
Sj(var3)  -Crfvart) 
-S, 

-Q 

o 


Hi 

a*j 


Q 

-S*| 

0 

0 

0 

0 


Hi 

du 


0 

0 

-1 

0 

0 

0 


Hi 

3yj 


S» 

c» 

0 

0 

0 

0 


3T* 
3  8t 


NOMENCLATURE 

varl  «Si(z4S}  +*jCj  —  HSj)  +Cj(  - yj  +L) 
var2  ■C|(z<S]  +*jCj  —  HSj)  +Sj(  — yj  +L) 
var3  *  -  t«C|  +  xjSj  +  HQ 
var3  ■  Z4S}  +XjCi  -HSj 
TaMa*  Cohuna  Vectors  of  the  Jacobin  ousts 
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DIFFERENTIAL  JOINT  COORDINATES 

( —  S\dax  +  C\day) 

( C\ax  +5^) 

NC2d(NS2)  -  NS2d(NC2) 

92  ~  {NSJ2  +  (NC2 )j 

dz4  —  C2A2d$2  +  ^2^2  +  C2dpz  —  S2A2d02 

dy$  —  Cipxd$\  +  S2dpx  +  Sipyd$i  —C\dpy 

jyi  C(,dot  +  S6dnz 

<"‘  =  V,  -  O, 

NOMENCLATURE 
NC2  =  -a, 
d(NC2)  —  —da, 

NS2  =  —C\ax  —  Sja, 

d(NS2)  —  S\axdB\  —C\dax  —  C\ayd$i  —  S\day 
A\  —C\px  +S\py 

A2  =  — S\pxd8\  +C\dpx  +C\pyd$\  +  S\dpy 


Table  S:  Inverse  Jacobian  of  the  CYRO  Robot 


STKP 

* 

-h 

■ 

■ 

SIN/ 

/cos 

TIM  Fin 
milliscc 

Find  the  mid-scam 

Butt  Joint  (l) 

3 

3 

0.384 

I.ap/Fillct  Joint  (2) 

3 

6 

0.462 

Compute  segment  travel  time  T 

Butt  Joint 

23 

39 

1 

5 

3.611 

l.ap/Fillct  Joint 

32 

61 

1 

6 

5.256 

F'ind  transition  point 

Butt  Joint 

23*N  , 

39*N, 

N, 

5*N  i 

7.222 

I.ap/Fillct  Joint 

32* N  , 

61*Nt 

N  i 

6*N , 

10.512 

Computation  of 

a  Vector 

9 

14 

5 

1 

1.611 

o  Vector  (6) -(7) 

15 

11 

3 

1 

1.675 

n  Vector  (8) 

3 

6 

0.462 

Compute  d  T  6  Matrix 

12 

0.576 

Normalization 

9 

4 

3 

3 

1.125 

Iterative  algorithm  (33)  -  (37) 

66  *N  2 

54*N  2 

6*N  2 

7.206 

Total 

Butt  Joint 

62  +  23*N| 

+  66*N? 

86  +  39*N, 
+54*N2 

15  +  N, 

10  +  N, 

6*N2 

23.872 

I  .ap/Fillct  Joint 

D 

10  + Ni 

6*N  2 

28.885 

Tabic  6:  Computational  Requirements  of  the  Scam  Tracing  Algorithm 
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Function 

Time(jis) 

Multiply 

Add 

Divide 

Square  Root 

Tangent 

90 

Exponentiation 

100 

Load 

10 

Store 
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Table  7:  Execution  Times  of  the  8086/8087  Microprocessor^  MHz  Gock)  Pntel  83] 


